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(54) APPARATUS FOR CONTROLLING MOVEMENT OF ROBOT AND METHOD OF CONTROLUNG 
MOVEMENT OF ROBOT 



(57) A tool (12) is moved by the jog-feed by a jog- 
teed command means toward a position (Pa) to which a 
teaching point is to be corrected. When the position of 
the tool approaches any teaching point (Ft) in a move- 
ment command program, a robot is automatically 
shifted to the teaching point Pt. Thus, an operator can 
recognize that the position, in which the robot is stopped 
is the teaching point (Pt) to be corrected in the move- 
ment command program. When the teaching point (PI) 
to be corrected is found, correction of a teaching point 
from the point (Pt) to the position (Pa) to be corrected is 
performed according to the same method as the con- 
ventional method. 
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Description 
TECHNICAL FIELD 

This invention relates to a robot movement control 
device and a robot movement control method to correct 
a teaching point set in a program to another position 
according to the movement of a tool. 

BACKGROUND ART 

In conventional control of an industrial rotx>t, an 
operator teaches a target point for the movement of a 
tool attached to the end of a robot arm. and a robot is 
nrx>ved according to a program generated so that the 
robot reaches this teaching point. Such a teaching point 
specified by the program is sometimes deviated from a 
set point as the result of varying the position or direction 
of a workpiece during work. In this case, it is necessary 
to con-ect the teaching point deviated from the set point, 
as n matter of course. 

When correction of a teaching point is performed in 
conventional robot control device, a command block of 
the teaching point is specified on the saeen of a teach- 
ing pendant, and the rotxrt is moved to the specified 
teaching point, and is further moved by jog-feed from 
the specified teaching point to a corrected teaching 
point. When the robot reaches the corrected teaching 
point, a coadinate point of the command block is auto- 
matically corrected by instructing correction on the 
teaching pendant. 

However, the conventional robot control device 
described above has needed to find the correspond- 
ence between a teaching point to be corrected and its 
command block. Even if this correspondence is found, it 
is necessary to alternate execution of a program and 
jog-feed operation with each other, and as a result, 
working efficiency is degraded. 

DISCLOSURE OF THE INVENTION 

It is an otsject of the present invention to provide a 
robot movement control device and a robot movement 
control method, which enable correction of a teaching 
point easily with accuracy. 

In order to attain the above object, as one mode of 
a robot movement control device according to the 
present invention, there is provided a rofcwt owvement 
control device which moves a robot tool to a predeter- 
mined teaching point and comprises a program storage 
means for storing a program to instruct the robot to be 
moved to the predetermined teaching point, a jog-feed 
commar^ means for instructing the robot to be moved 
by the jog-feed, a jog-feed control means for moving the 
robot by the jog-feed in the direction instructed by the 
jog-feed command means, and a teaching-point direc- 
tional movement control means for watching the posi- 
tion of the robot moved by the jog-feed, and instructing 
the jog-feed control means to shift the robot to a teach- 



ing point to which the robot comes closer, when the 
robot approaches any teaching point in the movement 
command program. 

Preferat)ly, the teaching-point directional movement 
5 control means is configured to shift the robot tool after 
the tool is reoriented to a posture instructed by the pro- 
gram. 

As another mode of the robot movement control 
device according to the present invention, there rs pro- 

10 vided a robot movement control device which moves a 
tool of a rot)ot to a predetermined teaching point and 
comprises a program storage means for storing a pro- 
gram to instruct the rot>ot to be moved to the predeter- 
mined teaching point, a jog-feed command means for 

IS instructing the robot to be moved by the jog-feed . a jog* 
feed control means for moving the robot by the jog-feed 
in the direction instructed by the jog-feed command 
means, a shifting command means for instructing the 
robot to be shifted to a predetermined teaching point. 

20 and a teaching-point directional movement control 
means for instructing the jog-feed control means to shift 
the robot to a teaching point, which is the closest to the 
position of the robot among teaching points in the move- 
ment command program, when the instructk>n to shift 

25 the robot is performed. 

Further, in a robot movement control method 
according to the present invention, a teaching-point 
move mode is set in a control device for controlling a 
robot. When the control device enters this teaching- 

3G point nnove mode by switching operation to move a tool 
attached to the end of a robot arm by the jog-feed 
toward a target position to which the teaching point is to 
be corrected a numerk:al control unit decides during the 
jog-feed as to whether or not the current position of the 

35 tool is within the range of a predetermined distance 
from a programmed teaching point. When decided that 
the current position of the tool is within the predeter- 
mined range, the tool is forcibly shitted to the pro- 
grammed teaching point, and is positioned at the target 

40 teaching point to be corrected. Furtha, when the cur- 
rent position of the tool is within the predetermined 
range of the programmed teaching point, the tool is 
shifted to the teaching point after the tool is reoriented 
to the directk)n taught in the programmed teaching 

4S point. 

According to the present invention, first, the tool is 
moved in the drection commanded by the jog-feed 
command means. When the tool approaches any 
teaching point in the movement command program, the 

so roboX is operated to shift the tod to the teaching point. 
As a result, an operator is able to judge a positk)n. in 
which the robot is stopped, to be one of teaching points 
in the movement command program. Further, if the tool 
is fed by jog-feed from this teaching point to a position to 

55 be set as a new teaching po\rtt, it is possible to correct a 
teaching point from a programmed teaching point to a 
target point for the movement of the tool. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a conceptual view tor explaining the func- 
tion of one entfMxiiment according to the present 
invention; 

Fig. 2 is a view showing the overall configuration of 

a robot control system inclixJing a robot movement 

control device according to the enrtfxxJiment; 

Fig. 3 Is a block diagram showing the hardware 

configuration of a robot control device; 

Fig. 4 is a view showing the schematic configuration 

of a panel face of a teaching pendant; 

Fig. 5 is a view showing the operation of a tool of a 

robot; and 

Fig. 6 is a flowchart showing a procedure on the 
side of a robot control device for controlling the 
movement of a robot according to the embocfiment. 

BEST MODE FOR EMBODYING THE INVENTION 

First of alt. a description will be given of the outline 
of a function according to an embodiment of the present 
invention with reference to Fig. 1. A program 1a to 
instruct a robot to be moved to a predetermined teach- 
ing point is Stored in a program storage means 1 . A jog- 
feed control means 3 moves a robot by jog-feed in the 
direction instructed by a jog-feed command means 2. 
For instance, the jog-feed control means 3 moves a toot 
4a along a jog command route L11. A teaching-point 
directional movement control means 5 watches the 
position of a robot 4 nx>ved by jog-feed, and instructs 
jog-feed control means 3. when the tool 4a (that is. a 
tool center point) of the robot 4 approaches any teach- 
ing point Px. to shift the tool 4a of the robot 4 to the 
teaching point Px in the movement command program 
1 a. As a result, the tool 4a goes out of the jog-command 
route L1 1 and is shifted toward the teaching point Px 
along a route LI 2. 

A description will now be given of the overall config- 
uration of a robot control system for embodying a robot 
movement control device as one embodiment of the 
present invention with reference to Fig. 2. A tool 12 is 
attached to the end of an arm 11 of a robot 10. The 
robot 10 Is adapted to machine or carry a workpiece 20, 
and its operation is controlled by a robot control device 
30. The operation of the robot 10 is instructed by a 
teaching pendant 40 connected to the robot control 
device 30. The teaching perKiant 40 has such a size as 
to make handy for an operator to carry. The teaching 
pendant 40 includes a liquid crystal display panel and 
various keys as will be described later. 

Fig. 3 is a block diagram showing the hardware 
configuration of the robot control device 30. The robot 
control device 30 includes a processor board 31. This 
processor board 31 includes a processor 31a. ROM 31b 
and RAM 31c. The processor 31a controls the entire 
robot control device 30 according to a system prog'am 
stored in ROM 31b. Various data such as a movement 
command program of the robot 10 are stored in RAM 



31c. Coordinates of a teaching point and the direction 
(i.e.. coordinates of an axis of rotation) of the tool 12 are 
stored in each command block of the nwvement com- 
mand program. Such a processor board 31 is con- 

£ nected to a bus 39. 

A digital servo control circuit 32 is connected to the 
bus 39» and drives servo motors 51 . 52. 53. 54 and 55 
through a servo annplif ier 33 according to the command 
from the processor board 31. These servo motors are 

^0 built in the robot 10 and operate each axis of the robot 
10. 

A serial port 34 is connected to the bus 39. and also 
connected to both the teaching pendant 40 with a dis- 
play and other RS232C apparatus 58. The teaching 

t5 pendant 40 has a size to nriake handy for an operator to 
carry, as described above, and is provided with a jog- 
feed button and a teaching point correction button or the 
like on the panel. CRT display 36a may be optionally 
connected to the serial port, and it is possible to check 

20 the working state or the like on the CRT display 36a. 

A console panel 36b is connected to a digital I/O 
unit 35, and the nrx>vement of the robot 10 may be 
instructed at the position of the robot control device 30 
through the teaching pendant. A drive portion to grip the 

25 tool 12 is connected to the digital I/O unit 35 which is 
able to instruct the gripping operation. When a machin- 
ing head for laser welding is used fa the tool 12. for 
instance, a welding power supply is connected to an 
anak)g I/O unit 37, and a wekiing voltage is instructed 

30 through the analog I/O unit 37. Teaching data and oth- 
ers are stored In a mass memory 38. 

Fig. 4 Is a view showing the schematic configuration 
of a panel face of the teaching pendant 40. A display 
screen 41 is a liquid crystal saeen, for Instance, and 

35 detailed data or the like in the movement command pro- 
gram is selectively displayed by switching. A furxnion 
key 42 Is a key which selects a menu displayed on the 
lower end of the display screen 41 . This function key 42 
also serves to perform switching to a teaching-point 

40 move mode and to instruct a correction of a teaching 
point. A teaching pendant valid switch 43 is a switch 
which makes the operatkin of the teaching pendant 40 
invalid from valid and vice versa. 

An emergency stop button 44 Is a button which 

45 stops the operation of the robot 10 in an emergency. A 
cursor key 45 is a key which moves a cursor displayed 
on the display screen 41. A ten-key pad 46 includes 
numerical keys and other keys which enable the input 
and deletion of numerical values and characters. 

so A jog -feed command means includes a shift button 
48 and jog -feed Ixjttons 47. First, either an orthogonal 
coordinate system (X. Y. 2) or each joint axis (Jl to J6) 
is selected by depressing a coordinate selection button 
49. In case where the orthogonal coordinate system is 

55 selected. If any one of the jog-feed 47 buttons indicating 
plus or minus linear direction for each of X, Y and Z axis 
is selectively depressed together with the shift button 
48. then the robot is moved by jog-feed in the selected 
direction for the selected axis. On the other hand, if any 
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one o1 the jog-feed buttons 47 indicating plus or minus 
rotational direction alxDut each of X. Y and Z axis is 
selectively depressed together with the shift tHJtton 48. 
then the robot is moved by jog-feed in the selected rota- 
tional direction about a selected axis. Further, in case 
where individual joint-axis feed mode comes into effect 
by depressing the coordinating selection Ixitton 49, i1 
any one of the jog-feed buttons 47 for each joint axis (J 1 
to J6) is selectively depressed, then jog-feed of the 
robot for the selected joint axis is carried out. 

A description, will now . be- given, of tfie. specific- 
processing contents of the robot movement control 
device as one embodiment of the present invention. 

Fig. 5 is a view showing the operation of the tool 12 
of the robot 10. In this case, a workptece 20 is a thin 
sheet, and the robot performs the operation of grq^ping 
this thin sheet (i.e.. workpiece 20). A point Pt of the 
workpiece 20 is assumed to be a teaching point prede- 
termined in the movement command program. A 
description will now be given of a case where an 
attempt to shift the tool 12 to a point Pa is made in order 
that the point Pa dose to the teaching point Pt is set as 
a new teaching point in place of the point Pt. 

First an operator depresses the jog-feed button 47 
on the teaching pendant 40 to shift the tool 12 (i.e.. a 
tool center point) Icward the target point Pa (along the 
route Li). During the movement of the tool 12, the 
teaching-point directional movement control means 5 
watches at all times the position of the tool moved by the 
jog-feed. When the tool 12 enters the range of a prede< 
termined radius from the teaching point Pt during the 
shifting of the tool 12 toward the point Pa, the teaching- 
point directional movement control means 5 detects the 
approach of the tool 12. In this case, "the range of a pre- 
determined radius" means a distance set to be shorter 
to some extent than the distance between this point Pa 
and any other teaching point. 

The teaching-point directional movement control 
means S reorients the tool 12. at the detected position 
Pc, so that its direction is same as the direction speci- 
fied in the teaching point Pt. Then this reoriented tool 12 
is shifted toward the teaching point Pt along the different 
track (along the route L2). When the tool 12 reaches the 
teaching point Pt. the tool 12 is stopped. When the tool 
center point of the tool 12 is stopped at the teaching 
point Pt, the correction of the teaching point is per- 
formed according to a method similar to the conven- 
tional method. That is, the operator depresses the jog* 
feed button 47 to sNft the tool to the target point Pa. 
When the tool reaches the point Pa, the correction of 
the teaching point is instructed by depressing the func- 
tion key 42 or the like. As a result, rewrite from the coor- 
dinate data of the teaching point Pt to the coordinate 
data of the point Pa is performed on the side of the robot 
control device 30. 

A description will now be given of the procedure in 
case where the processor 31a of the robot control 
device 30 performs the above operation with reference 
to the flowchart shown in Fig. 6. 



The function key 42 is depressed to switch a mode 
to the teaching-point move mode, and the jog-feed but- 
ton 47 is depressed to start a shifting control so as to 
shift a teaching point toward a position to be corrected 

5 (Step Si). An axis is controlled accoiding to the 
selected coordinate system and the axis and its direc- 
tion corresponding to the depressed jog-feed button 47, 
and the jog-feed of the tool 12 is started (Step S2). it is 
decided as to whether or not the jog-feed command is in 

10 the off state (Step S3). When the jog-feed command is 
not in the off state, it is decided as to whether or not the 
teaching-point move mode is selected (Step S4). When 
the teaching-point nnove mode is not selected, process- 
ing is returned to Step S3. On the other hand, when the 

75 teaching-point move mode is selected, it is decided as 
to whether or not the position of the jog-fed tool 12 is 
within the range of a predetermined radius (i.e.. within 
the predetermined distance) from any teaching point in 
the movement command program (Step S5)- When 

20 decided that the position of the tool 12 is outside the 
range of the predetermined distance, processing is 
returned to Step S3. On the other hand, when decided 
that the positk>n of the tool 1 2 is within the range of the 
predetermined distance, then it is decided as to whether 

25 or not the tool 12 approaches the teaching point (Step 
S6). When decided that the tool approaches the teach- 
ing point, processing is advanced to Step S7. On the 
other hand, when decided that the tool is moved away 
from the teaching point, processing is returned to Step 

3G S3. 

That is, while the jog-feed command is in the on 
state, processing in Steps S3 to S5 is repeatedly exe- 
cuted. When the distance between the current position 
of the tool 12 and the teaching point is within the prede- 

35 termined range (Step S5). it is decided as to whether or 
not the tool approaches the teaching point by the jog- 
feed (Step S6). When decided that the tool approaches 
the teaching point by the jog-feed, processing is 
advanced to Step S7. In Step S7. the tool 12 is automat- 

40 ically reoriented to the direction as it is programmed in 
the above teaching point. Further, it is decided as to 
whether or not the jog-feed command is in the off state 
(Step S8). When decided that the jog-feed command is 
not in the off state, then it is decided as to whether or not 

45 the tool 12 is completely reoriented (Step S9). Process- 
ing in Steps S8 and S9 is repeatedly executed until the 
tool 12 is connpletely reoriented. 

After the tool 12 is completely reoriented, the shift- 
ing of the tool 12 toward the teaching point Pt is auto- 

50 matically started (Step SIO). Then, it is repeatedly 
decided as to whether or not the jog-feed command is in 
the off state, and whether or not the tool 12 reaches the 
target teaching point Pt when deckled that the jog-feed 
command is not in the off state (Steps Sll and 12). 

55 When the tool 12 reaches the target teaching point Pt, 
the robot is stopped even if the jog-feed command is in 
the on state (Step Si 3). In this manner, when the oper- 
ation of the robot is stopped even if the jog-feed com- 
mand is in the on state, the tool 12 is regarded as 
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having reached the teaching point. Therefore, the cor- 
rection of the teaching point is afterward performed 
according to the same method as the conventional 
method. 

Incidentalty. when the robot lO is stopped before 
the tool 12 exactly reaches its desired teaching point 
(i.e.. when the tool is stopped at a wrong teaching 
point), the jog-feed command is set to the on state to 
move the tool 12 away from the teaching point. As a 
result, processing in Steps Si to S6 is executed. In this 
case, since the toot does not approach the teaching 
point in Step 36. processing is returned to Step 3. and 
the tool 12 is moved away from the teaching point as it 
is. Then, the tool is moved by jog-feed toward the 
desired teaching point, and processing in Steps 31 to 
313 is executed to position the tool 12 at the desired 
teaching point. When the jog-feed command is set to 
the off state in Steps S3. S8 and Si 1 before the tool 12 
reaches the teaching point, the movement of the robot 
is stopped. However, in this case, when the jog-feed 
command enters again, processing in Steps Si to 313 
is executed, and therefore, the too! is able to be moved 
to and stopped at the desired teaching point. 

As described above, according to the present 
invention, when a tool approaches a teaching point set 
in advance in the nrx)vement command program while 
moving by jog-feed toward a point to be set as a new 
teaching point, the toot is automatically shifted to the 
predetermined teaching point. Therefore, an operator is 
able to recognize that the position where the robot 1 0 is 
stopped is a teaching point in the movement command 
program. Further, it the tool is moved by jog-feed from 
that position to a target position (i.e.. a point to be set as 
a new teaching poHit) according to the conventional 
operation, it is possible to perform the correction of a 
teaching point. Therefore, time required for work is 
reduced. 

Further, according to the embodiment of the 
present invention, when the movement according to the 
jog-feed command inputted by the operator is changed 
to the automatic shifting to a teaching point, the direc- 
tion of the tool 12 is changed to the same direction as 
the direction specified by the program data of the teach- 
ing point before change of the moving direction. There- 
fore, it is possible to prevent the tool from interfering with 
another part of a workptece. and work with more accu- 
racy is enabled. 

According to the embodiment of the present inven- 
tion, the too) is automatically shifted toward the teaching 
point at a point of time when the tool approaches the 
teaching point. However, this shifting may also be made 
according to the operator's specific operation on the 
teaching pendant 40. 

Further, in the embodiment of the present invention, 
a description has been given of a case where the tool 12 
of the robot 10 grips a workpiece. But, the present 
invention may be applied to a tool such as a welding 
head. 



Claims 

1. A robot movement control device to move a robot 
tool to a predetermined teaching point, comprising: 

5 

a program storage means for storing a program 
to instruct the robot to be moved to the prede- 
termined teaching point; 
a jog-feed command means for instructing the 

10 robot to be moved by the jog-feed; 

a jog-feed control means for moving said robot 
by the jog-feed in the direction instructed by 
said jog-feed command means; and 
a teaching-point directional movement control 

/5 means for watching the position of the robot 

nrKved by the jog-feed, and instructing said jog- 
feed control means to shift said robot, when it 
approaches any teaching point in the move- 
ment command program, to a teaching point to 

20 which the robot comes closer. 

2. A robot movement control device according to claim 
1. wherein said teaching-point directional move- 
ment control means shifts said robot tool after said 

25 tool is reoriented to a posture instructed by said 
program. 

3. A robot movement control device to move a robot 
tool to a teaching point given in advance, compris- 

3C ing: 

a program storage means for storing a program 
to instruct the robot to be moved to the prede- 
termined teaching point; 

35 a jog-feed command means for instructing the 

robot to be moved by the jog-feed; 
a jog-feed control means for moving said robot 
by the jog-feed in the direction instructed by 
said jog-feed command means; 

40 a shifting command means for instructing the 

robot to be shifted to a teaching point given in 
advance; and 

a teaching-point directional movement control 
means for instructing said jog-feed control 
45 means to shift said robot to a teaching point 

which is the closest to the position of said robot 
among the teaching points in said movement 
command program, when said instruction to 
shift the robot is performed. 

so 

4. A robot movement control method, in which: 

a teaching-point move mode is set in a control 
device for controlting a robot; 
55 when a tool attached to the end of a robot arm 

is moved by the jog -feed toward a target posi- 
tion to which a teaching point is to be corrected 
according to said mode, a numerical control 
device decides, during the movement of the 
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tool by the jog-feed, as to whether or not the 
current position of the tool is within the range of 
a predeterminecl distance from a programmed 
teaching point; and 

when decided that the current position of the 5 
tool is within the predetermined range, the tool 
is forcitDly shifted to said teaching point and 
positioned at said target teaching point to be 
corrected. 

10 

5. A robot movement control method according' to"^ 
claim 4, wherein when the current- position of the*^ 
tool Is within the predetermined range of the pro- 
grammed teaching point, the tool is shifted to said 
teaching point after said tool is reoriented to the /s 
direction as is taught in said teaching point. 
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